import numpy as np
#from point import Point
import visualizer

def distance(point1, point2):
    return np.sqrt((point1[0] - point2[0])**2 + (point1[1] - point2[1])**2)

def distMat(points):
    n = len(points)
    dist = np.zeros((n,n))
    for i in range(n):
        for j in range(n):
            dist[i,j] = distance(points[i], points[j])
    return dist


#index of point
points = np.array([
    [4,2,5,1,2,3],
    [2,4,6,1,2,1]
    ]).T

paths = np.array([
    [2,5,1],
    [4,6,1]
    ]).T

print("points:")
print(points)

print("dist:")
print(distMat(points))
distMat(points)
visualizer.visualize(points, paths)


